package edu.wpi.first.wpilibj.templates.subsystems;

import edu.wpi.first.wpilibj.command.Subsystem;
import edu.wpi.first.wpilibj.CANJaguar;
import edu.wpi.first.wpilibj.can.CANTimeoutException;
import edu.wpi.first.wpilibj.templates.HardwareMap;

public class Wedge extends Subsystem {
    
    CANJaguar Motor; 
    
    //Same as Feeder
    private static final int POLARITY = 1; 
    
    public Wedge(){
        super("Wedge");
        try {
            Motor = new CANJaguar(HardwareMap.WEDGE_JAGUAR);
        }
        catch (CANTimeoutException e){
            e.printStackTrace();
        }
    }
    
    public void initDefaultCommand() {
    }
    
    public void Move(double Speed){
        //Same as Feeder
        try {
            Motor.setX(POLARITY*Speed);
        }
        catch (CANTimeoutException e){
            e.printStackTrace();
        }  
    }
}